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1.  Introduction 


Trajectory  planning  algorithms  seldom  incorporate  extensive  knowledge  of  the  interaction 
between  inverse  dynamics  and  actuator  torque  limits  into  the  planning  process.  Past  efforts  have 
typically  used  fixed  velocity  limits  of  the  joints  as  a  way  of  determining  how  fast  a  trajectory 
may  be  executed  (8],  Due  to  the  complex  relationship  between  joint  velocities  and  dynamics, 
such  a  procedure  is  at  best  a  very  coarse  approximation  of  the  true  influence  of  actuator  limits 
on  trajectory  speed.  An  exact  method  for  determining  the  optimal  velocity  distribution  for 
a  fixed  path  has  been  proposed  in  [13],  where  dynamic  programming  was  straightforwardly 
applied  to  minimize  energy  under  actuator  and  dynamic  constraints.  The  computational  cost  of 
such  optimization  approaches  however  may  prevent  their  useful  application. 

We  develop  a  fundamental  time-scaling  property  of  manipulator  dynamics  that  allows 
trajectory  planning  and  inverse  dynamics  to  be  exactly  and  efficiently  coupled.  'Ihc  dynamic 
realizability  of  a  proposed  trajectory  can  be  readily  determined,  and  a  simple  procedure  to 
modify  the  movement  speed  can  be  applied  to  render  proposed  trajectories  realizable. 

We  presume  that  a  time  sequence  of  joint  angles  £(t)  =  (0i(i),  02 (t), . . .,  0n(O)  f°r  an  n-joint 
manipulator  has  been  proposed  by  the  trajectory  planner,  where  t  represents  the  time  in  the 
interval  0  <  t  <  tj.  Because  of  fast  recursive  formulations  of  inverse  dynamics  [4,  7,  11],  for 
each  sampling  time  t  the  joint  torques  n(f)  =  (ni(t),n2(t), ...,nn(t))  corresponding  to  0(f) 
can  be  efficiently  found.  The  comparison  of  n(t)  against  motor  torque  limits  is  therefore  readily 
accomplished,  and  it  is  straightforward  to  determine  whether  the  proposed  trajectory  can  be 
realized  by  the  actuators. 

A  more  difficult  task  is  to  ascertain  how  to  change  the  trajectory  in  case  motor  torque  limits 
are  violated.  Here  we  consider  only  changing  the  speed  at  which  a  manipulator  follows  a  path, 
where  by  speed  change  is  meant  a  constant  scaling  of  the  velocity  profile  so  that  the  total 
movement  duration  is  scaled  without  changing  the  actual  path  through  space.  It  is  not  sufficient 
merely  to  slow  down  a  trajectory,  with  the  hope  that  a  slower  trajectory  requires  lower  motor 
torques,  because  some  trajectories  can  only  be  realized  at  higher  speeds,  and  some  trajectories 
may  not  be  realizable  at  any  speed.  Moreover,  unless  one  is  careful  to  employ  an  algorithm  such 
as  is  presented  here,  then  modifying  the  movement  speed  requires  that  the  inverse  dynamics  be 
recomputed  from  scratch. 

The  algorithm  presented  here  determines  what  speed  range  is  permissible  for  the  proposed 
trajectory  given  actuator  torque  limits.  At  the  same  time  the  nominal  dynamics  for  the  proposed 
trajectory  can  be  simply  modified  for  the  new  trajectory,  without  dynamics  rccomputation. 

2.  l  ime  Scaling  and  Trajectories 

Suppose  that  some  trajectory  plan  0(t)  has  been  fashioned.  A  new  trajectory  0(f)  will  be  defined 
such  that  i(t)  —  0(r),  where  r  =  r(t)  is  a  monotonically  increasing  function  of  time  with 
r(0)  —  0  and  r(t,)  —  tj  for  some  fj  >  0.  The  function  r(t)  can  be  considered  a  time  warp 
which  moves  the  arm  along  the  same  path  but  with  a  different  time  dependence,  perhaps  going 
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slower  along  some  points  of  the  path  and  faster  along  others.  r(t)  must  increase  monotonically 
because  time  cannot  reverse  itself,  and  r(0)  =  0  because  the  movement  must  start  at  the  same 
point. 

To  determine  how  the  dynamics  of  the  arm  changes  for  the  new  trajectory,  the  time  derivatives 
of  the  joint  angles  are  required.  From  the  chain  rule. 


d6(t)  _  dO(r)dr 
dt  dr  dt 

or,  using  the  dot  notation  for  time  derivatives, 

kt)  =  £(r)f  (1) 

where  d6(r)/dr  has  been  written  0(r)  because  it  takes  the  value  0  evaluated  at  r(t).  Similarly, 

I(t)  =  g(r)r(<)2  +  g(r)f(f)  (2) 

The  dynamic  equations  of  motion  can  be  compactly  written  [4]  as 

n(t)  =  i  mmit) + 9(t) .  cm)  ■  m + tim  (3) 

where 

n(t)  is  the  n -dimensional  vector  of  net  joint  torques  corresponding  to  the  movement 
point, 

l(0(t))  is  the  n  X  n  generalized  inertia  tensor  of  the  manipulator, 

C(0(t))  is  the  n  X  n  X  n  position-dependent  tensor  in  the  formulation  of  the  Coriolis 
and  centripetal  torques,  and 

g(0(t))  is  the  position-dependent  rc -dimensional  vector  of  grav  ity  torques. 

The  notation  for  the  velocity  product  term  0  •  C  •  0  is  slightly  unconventional,  but  has  been 
adopted  for  compactness,  lhc  product  C-jisannXn  matrix  with  element  ij  as  CijkOk, 
which  in  turn  is  multiplied  against  9  to  yield  an  n  X  1  vector. 

In  the  following  derivations,  the  acceleration  and  velocity  dependent  torques  arc  treated 
separately  and  arc  designated  as  n„(t)  =  (n0l(f), n02(t)>  •  ••,non(0)>  50  that  n(t)  =  na(t)  + 
g{0(*)).  For  the  new  trajectory  0(t), 


na(t)=imw)+ht)cm-m 

Substituting  from  (1)  and  (2), 


.(<)  = 


I (0(r))l(r)  +  t(r)  •  C(0(r))  •  0(r)  fs  +  l(0(r))£(r)»i 


Rearranging  and  substituting  from  (3), 

fi.(O  =  ^«.(r)  +  H(0(r))0(r) 


□  □ 
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This  is  a  potentially  significant  reformulation  of  dynamics,  indicating  how  the  underlying 
dynamics  changes  when  the  time  dimension  of  a  trajectory  changes.  The  new  torque  n«(t)  is 
related  to  the  old  n«(r)  by  the  scaling  factor  fa  plus  a  term  proportional  to  the  generalized 
momentum  l(£(r))g(r)  of  -the  manipulator.  Note  that  the  gravity  torque  g (£(t))  =  g (tf(r))  is 
not  sealed  since  it  is  position  dependent  only,  which  is  the  reason  for  the  separation  between 
n*(f)  and  the  gravity  torques. 

11  Constant  Time  Scaling 

The  simplest  instance  of  (7)  is  when  r(t)  =  0,  i.e.,  r(t)  =  ct  for  some  constant  c  >  0.  If 
c  >  1  the  movement  is  sped  up;  if  c  <  1  the  movement  is  slowed  down.  Then 

»«(*)  =  can«(ct)  (7) 

Interestingly,  movement  speed  can  be  proportionally  changed  without  affecting  the  underlying 
dynamics  very  much,  so  long  as  the  gravity  contribution  is  separated  from  the  acceleration  and 
velocity  term  contributions.  Ihe  relation  was  also  noted  by  Bcjzcy  [1],  Humans  apparently  adopt 
such  a  strategy  when  changing  movement  speed,  perhaps  to  simplify  the  dynamics  computation 
[5]. 

This  relation  also  shows  that  the  velocity  and  acceleration  terms  of  the  dynamics  would  have 
the  same  significance  relative  to  each  other  for  all  speeds  of  movement  For,  the  acceleration 
term  l(0(t))0(t)  is  scaled  by  ca  from  (2),  and  the  velocity  term  0(f)  ■  C(0(t))  ■  0(f)  receives  a 
c  factor  for  each  £(f).  Thus  both  terms  change  equally  with  differing  movement  speeds.  This 
contradicts  the  normal  assumption  in  the  robotics  literature,  where  in  designing  control  systems 
workers  typically  throw  out  the  velocity  terms  because  they  are  a  nonlinear  product,  with  the 
presumption  that  they  are  significant  only  at  higher  speeds  of  movement  (1,10).  For  the  slow 
movement  speeds  of  most  manipulators,  and  hence  because  of  the  predominance  of  frictional 
and  gravitational  effects,  this  is  a  reasonable  assumption  [2],  But  for  consistency  the  acceleration 
terms  should  be  thrown  out  as  well  since  they  share  the  same  significance  as  the  velocity  terms, 
yet  this  is  not  done.  In  any  case,  future  generations  of  robots  will  contain  examples  of  fast 
manipulators  with  low  joint  friction  where  dynamic  effects,  both  acceleration  and  velocity  terms, 
arc  highly  significant  (2). 

In  the  remainder  of  this  paper,  we  assume  the  special  ease  (7)  and  use  it  to  determine 
allowable  speeds  of  movement  for  a  given  trajectory.  By  allowable  speed  it  is  meant  that  the 
trajectory  is  stretched  or  compressed  uniformly  to  fit  the  allotted  duration  without  changing 
the  path  or  the  velocity  profile  shape.  Constant  scaling  of  velocity  is  a  simple  but  important 
method  of  bringing  a  trajectory  within  actuator  constraints.  Certainly  there  are  many  classes  of 
manipulator  trajectories  where  an  exact  path  through  space  must  be  followed,  as  in  straight-line 
Cartesian  motions  of  the  manipulator  hand  [9,  12],  but  where  the  time  dependence  along  the 
path  is  not  strongly  restricted.  While  non-uniform  time  scaling  may  yield  a  realizable  trajectory 
where  a  constant  scaling  would  not,  results  for  the  general  case  (6)  arc  not  yet  available  while 
other  approaches  [13]  may  be  too  computationally  inefficient  for  routine  use.  Even  more  difficult 
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is  path  modification  under  actuator  and  dynamic  constraints,  for  which  no  genera]  results  are 
yet  available  (see  however  (6]  for  an  approximate  time-optimal  trajectory  planning  solution). 

3.  Time  Scaling  of  Trajectories  to  Satisfy  Torque  Limitations 

Torque  limits  of  actuators  restrict  how  fast  a  manipulator  may  move  along  a  trajectory.  In 
order  to  determine  whether  a  proposed  trajectory  £(£)  violates  actuator  limits,  the  inverse 
dynamics  must  be  solved  and  the  computed  torques  compared  to  these  limits.  Suppose  we 
have  computed  the  acceleration  and  velocity  dependent  torques  na(£)  separately  from  the 
gravitational  torques  g{0(£)).  Suppose  further  that  the  maximum  and  minimum  torque  limits, 
n+  =  (ni’.nj", . . .,n+)  and  n—  =  respectively,  are  constant  throughout 

a  movement.  (Ordinarily  one  would  presume  n+  =  — n_.)  Later  we  consider  velocity 
dependencies  as  in  electric  torque  motors. 

At  a  given  position  9(t)  of  the  manipulator,  some  of  the  actuator  torque  is  required  for 
postural  support  of  the  manipulator  only.  In  terms  of  what  torque  capability  is  remaining 
to  actually  generate  a  movement,  we  formulate  new  effective  torque  limits  by  absorbing  the 
gravitational  torques  into  the  torque  limits,  i.e., 

n+(t)=n+-g(tf(t)) 
n“(t)  =n~  -  g(0(t)) 

Note  that  the  torque  limits  are  now  position  dependent,  and  hence  have  been  written  as 
functions  of  time. 

Because  we  are  looking  for  a  time  scaling  value  c  that  brings  the  trajectory  within  the 
torque  limits,  a  slight  alteration  of  (7)  is  required.  Since  (7)  holds  for  all  times,  we  can  write 
na(t/c)  =  cJn0(t)  and  the  torque  limits  for  the  new  trajectory  as  n ±{t/c)  —  n±(£).  We  require 
that  for  the  new  trajectory  iia(t/c)  be  bounded  by  n^t/c),  which  is  done  by  finding  the  c  that 
bounds  c2n„(t)  by  n±(t)  according  to  the  following  procedure. 

For  each  time  t  and  joint  i,  we  find  the  minimum  and  maximum  scaling  values  of  c2  that 
satisfy  the  torque  limits  by  solving  (7)  together  with  the  computed  torques  not(f)  and  the  torque 
limits  n^~(t)  and  n'^(t).  The  result  will  be  denoted  by  the  interval  [c?— (£),  (t)],  where  any 

scaling  value  within  this  interval  is  a  permissible  movement  speed  for  this  joint  at  this  point  in 
the  trajectory.  This  scaling  interval,  however,  may  violate  constraints  at  other  joints  and  times, 
and  the  permissible  range  of  c2  values  for  the  whole  movement  is  found  by  intersecting  all  such 
intervals: 


We  can  then  choose  any  value  in  the  final  interval  fc2-,c2+]  to  generate  a  movement  which 
satisfies  the  actuator  constraints. 

To  determine  [c?"(£),c,2+(f)j,  there  arc  three  cases. 
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Oise  1:  n+(f)  >  0,  n~(f)  <  0. 

Condition  c?~(t)  c?+(t) 

n«(0  >0  0  »*(<)/»«(*) 

naj(t)  =  0  0  oo 

n«i(t)  <0  0  n~(t)/n*i(t) 

Case  2:  n^(t)  >  0,  n~{t)  >  0. 

Condition  c?~(0  c*+{t) 


n«(t)  >0  ni  {t)/nai{t)  n+(t)/noi(t) 
n«(0  <  0  unrealizable 

Case  3:  n^"(t)  <  0,  n^“(t)  <  0, 

Condition  c?~(t)  c*~*~(t) 

nai(t)  >  0  unrealizable 

n«(t)  <  0  n,+ (t)/n*i(t)  n~[t)/nai[t) 


To  explain  these  cases,  consider  first  case  1.  The  minimum  value  of  c3  is  zero  because 
nai(t)  =  0  falls  within  actuator  bounds  and  c3  must  be  non-negative.  If  n„i(t)  >  0,  then 
the  appropriate  torque  limit  for  comparison  is  n,+(t).  because  time  scaling  can  change  a 
torque  magnitude  but  not  a  sign.  The  maximum  value  of  c3  is  then  determined  by  the  ratio 
n^-(t)/noi(f).  Note  that  when  n„i(t)  <  n^(t),  then  c3  >  1  and  it  is  possible  to  speed  the 
movement  up  and  still  satisfy  actuator  constraints.  When  not(t)  >  nt+  (t),  c3  <  1  and  the 
movement  must  be  slowed  down.  To  complete  case  1,  if  n„,(t)  <  0,  the  appropriate  torque 
limit  is  n~(t)  and  the  maximum  value  of  c3  is  n~(t)/n^(t). 

In  case  2,  if  na,(t)  <  0,  then  this  movement  is  unrealizable  at  any  speed.  The  actuator 
can  produce  only  a  positive  torque,  but  a  non-positive  torque  is  required  by  the  movement 
Put  simply,  the  manipulator  cannot  even  hold  itself  up  at  this  position.  Of  course  manipulator 
actuation  is  ordinarily  designed  to  counteract  gravity,  but  this  actuation  may  become  inadequate 
if  urn  heavy  a  loud  is  picked  im.  I-'or  n„,(£)  >  0,  the  maximum  movement  speed  is  determined 
by  the  ratio  n*(0/n*»(t)  an(*  the  minimum  by  n“(f)/n«,(t).  It  is  possible  that  c?~(t)  >  0, 
which  says  that  there  is  a  minimum  non-zero  speed  at  which  the  movement  is  realizable.  Also 
it  is  possible  that  cf~  {*)  >  1,  so  that  the  movement  can  be  realized  only  by  speeding  up.  Case 
3  is  analogous  to  case  2,  except  that  the  roles  of  n+(t)  and  n“(t)  are  reversed  due  to  sign 
change. 

The  intersection  of  all  the  intervals  [e3~(t),  ej+(t)]  may  be  null,  with  incompatible  scaling 
requirements  at  different  parts  of  the  trajectory.  This  movement  is  then  unrealizable  at  any 
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speed.  If  c2~  >  1,  then  the  movement  should  be  speeded  up  by  at  least  a  factor  ca~,  while 
if  ca+  <  1  the  movement  should  be  slowed  by  at  least  a  factor  c2^  in  order  to  produce  a 
realizable  trajectory.  Having  chosen  a  c2  value,  the  inverse  dynamics  can  be  simply  recomputed 
from  the  old  values  of  na(t)  and  g(6(t))  as  follows: 

n(t)  =  c2ntt(e<)  -f  g(0(ct))  (10) 

The  acceleration  and  velocity  torques  arc  amplitude  sealed,  the  gravity  torque  is  added  in 
separately,  and  both  together  arc  time  sealed.  Speed  change  can  therefore  be  accomplished 
without  dynamics  rccomputation. 

4.  Examples 

This  algorithm  will  be  illustrated  for  straight-line  movements  by  a  two-link  planar  manipulator 
(Kigurc  1);  the  algorithm  is  quite  easily  applied  to  manipulators  with  more  degrees  of  freedom. 
This  manipulator  has  two  rotary  joints  with  joint  angles  0\  at  the  shoulder  and  at  the  elbow. 
Ihc  axes  of  rotation  arc  both  directed  along  the  z-axis,  so  that  the  manipulator  only  generates 
movement  in  the  x-y  plane.  Gravity  is  presumed  to  act  in  the  negative  y  direction  with 
magnitude  g.  The  length,  mass,  and  moment  of  inertia  about  the  proximal  joint  for  each  link 
are  designated  as  U,  m„  and  /,  respectively,  where  t  =  1  refers  to  the  upper  ami  link  and 
t  =  2  refers  to  the  forearm  link.  Each  link  is  a  uniform  cylinder  with  radius  R. 

The  equations  of  motion  arc  [2]: 


•i  ( .  .  rriilih  n  i  ,  n  ( r 

—  0il  fa  H - ^ —  C08^a  'I — 1  +  M  h  H — I 


(in 
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..(  nM?  +  ma/j  \ 

ni  =  iM  h  *f  h  +  ma/i/aco«fa  H - - - H  mafj  j 

+h[h  +—-  +  -1  C0‘  *)  (12) 

— m2^3  $1  sin  $2  —  wa/j/ai^a  ain  da 

+  (-^co»(®l  +  ^a)  +  +  majcOsdijff 

A  common  class  of  manipulator  trajectories  arc  straight  line  movements  of  the  tip,  i.e., 
y  —  yo  =  (x  —  x0)(yi  —  yo)/(*t  —  *o)  for  beginning  and  end  positions  of  the  tip  (z0,  yo) 
and  (xi,  yi)  respectively.  To  solve  the  inverse  dynamics,  it  is  required  to  transform  from  the 
position,  velocity,  and  acceleration  of  the  tip  to  the  position,  velocity  and  acceleration  for  each 
joint  angle.  These  inverse  kinematic  equations  arc  presented  below  [2]: 


cos  $2  — 


x2  +  y*  —  l\  —  l l 


4  .  tan"1  [ y-)  -  tan"1  ) 

1  \xj  Ui  +  /aeo.4/ 


(13) 


ii 

i 

la  cos(di  +  da)  fa  »in(di  +  da)l  f *] 

$i  +  4 

ft<2  sin  da 

.  — ficosdi 

— fisindi  Jlyj 

dt 

1 

ffa  cos(di  -j-  da)  fa  rin(di  -f  da)]f£] 

Si  +  4 

l\l%  sin  dj 

l  — 1\  COB  di 

— fi  sin  di  JillJ 

+ 


1 

fiiacosda 

*  ' 

fifa  sin  da 

—  ft /a  COB  $2 

(di  +  d2)2 

(15) 


Three  different  movements  are  illustrated  in  the  examples  below:  one  that  must  be  slowed 
down,  one  that  must  be  sped  up,  and  one  that  is  unrealizable  at  any  speed.  For  the  link 
parameters,  we  have  set  ii  =  fa  =  0.5  meters,  mi  =  mj  =  1  kg,  I\  =  1%  =  mifj/12  + 
mi/?2/4,  R  =  O.lii,  and  g  —  9.8  m/sec2. 


4.1  A  Movement  Whose  Speed  Is  Scaled  Down 


A  straight  line  motion  from  (*o.yo)  =  (0.5,— 0.5)  to  (ii,yi)  =  (0.5,0)  is  to  be  generated 
at  a  constant  velocity  of  4  meters/sccond.  The  torque  limits  for  the  actuators  are  set  at  nj*"  = 
— nf  =  6.9  kg-m,  and  nf  =  —  nf  =  2  kg-m.  A  comparison  between  n+(£),  n“(£),  and 
na(f)  is  presented  in  Figure  2. 
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Figure  2 

Torque  profiles  for  a  constant-velocity,  straight-line  trajectory  of  4  m/sec  from  (x,y)  =  (.5,  —.5)  to  (.5,0) 
when  nj*"  =  — nf  =  6.9  kg-m  and  nf  =  — nj‘  =  2  kg-m.  (a)  Joint  1  minimum  and  maximum  torques, 
«7(t)  and  n+(t),  and  the  velocity  and  acceleration  torque  na,(t)  are  shown  versus  time;  (b)  corresponding 
torque  profiles  for  joint  2. 


Joint  1  is  represented  by  Figure  2a,  where  the  torque  requirements  n0i(t)  for  the  complete 
movement  fall  within  the  modified  actuator  constraints  njf  (f)  and  nj'(t).  For  joint  2  in  Figure 
2b,  however,  the  required  torque  no2(f)  falls  below  the  lower  actuator  bound  njf(t)  for  the 
initial  movement  segment.  This  suggests  that  the  movement  must  be  slowed  down.  By  scaling 
the  torque  no2(t)  by  a  factor  c2  <  1,  the  elements  of  the  new  torque  na2(i)  become  larger 
(i.e.,  less  negative).  The  no2(t)  curve  could  then  be  made  to  lie  completely  above  the  rff  (t) 
curve,  as  if  it  had  been  shifted  upwards. 

Carrying  out  the  computations  in  (9),  it  is  found  that  [c2~  ,c2+j  =  [0.582,0.745].  The  value 
c2+  =  0.745  arises  from  joint  2  at  time  t  =  0.035  sec.,  while  the  value  c2—  =  0.582  arises 
from  joint  1  at  the  same  time.  Ihus  the  fastest  speed  at  which  this  movement  can  be  executed 
is  determined  by  4v/0.745  =  3.45  m/s.  On  the  other  hand,  there  is  a  non-zero  lower  speed 
limit,  4>/.582  =  3.05  m/s.  Kxamining  Figure  2a,  if  the  movement  is  slowed  too  much,  then 
the  n0j(t)  curve  is  displaced  upwards,  intersecting  the  n/" (t)  curve  and  exceeding  that  upper 
torque  limit 

4.2  A  Movement  Whose  Speed  Is  Scaled  Up 

As  shown  above,  if  the  movement  speed  falls  under  3.05  m/s,  then  the  actuator  limits  arc 
exceeded.  This  condition  is  verified  here  by  considering  the  same  movement  but  executed 
at  2  m/s  and  by  working  through  the  algorithm.  Figure  3a  shows  that  the  shoulder  torque 
nai(f)  exceeds  the  upper  actuator  bound  at  the  beginning  of  the  movement  Calculations 
show  that  for  joint  1,  c3~  =  2.329  at  t  =  0.035  s,  so  that  die  movement  must  be  sped  up 
by  2>/2.329  =  3.05  m/s  as  predicted.  This  would  push  the  n„i(t)  curve  down  until  it  is 
completely  beneath  nf[t).  The  curve  nf  (t)  is  the  same  as  in  Figure  2a,  but  has  been  left  out 
here  to  allow  an  expanded  scale. 

Iltcrc  is  an  upper  limit  of  c2+  =  2.981  at  l  =  0.035  s  as  well,  determined  this  time  by 
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Figure  3 

Torque  profiles  for  a  constant-velocity,  straight-line  trajectory  of  2  m/sec  with  other  conditions  the  same 
as  in  Figure  1 


Figure  4 

Joint  2  torque  profiles  for  the  same  movement  as  in  Figure  3  except  with  =  i  kg-m. 


joint  2  (Figure  3a).  If  the  curve  n^t)  is  pushed  down  too  far,  it  will  violate  the  lower  bound 
n^f(t).  Thus  the  fastest  this  movement  can  be  executed  is  2\/2.981  =  3.45  m/s,  in  agreement 
with  the  first  movement  analysis. 

4.3  An  Unrealizable  Movement 

For  the  third  movement,  the  conditions  arc  the  same  as  for  the  second  movement,  but  the 
second  actuator  limits  are  now  changed  to  nf  =  — n£"(t)  =  l  kg*m.  As  before,  the  actuator 
limits  on  joint  1  (Figure  3a)  require  that  the  minimum  speed  for  this  movement  be  determined 
by  c2~  =  2  329.  But  Figure  4  shows  that  the  joint  2  actuator  limits  prevent  any  higher  speed 
scaling  than  c*+  =  1.522,  because  n«a(t)  would  fall  below  nf(t).  Thus  there  are  incompatible 
scaling  rcquirctnena,  and  this  movement  cannot  be  realized  at  any  speed. 

5.  Velocity' Dependent  Motor  Limits 

We  have  assumed  above  that  the  actuator  limits  n+  and  n“  are  constant  throughout  the  motion. 


In  reality,  the  maximum  actuator  torque  often  docs  depend  on  velocity,  such  as  for  electric 
torque  motors.  For  the  ease  of  a  low-inductance  motor  with  no  dissipative  effects  [3J, 

V  =  IR  +  Kv  w  (16) 

where  V  is  the  motor  voltage,  I  is  the  motor  current,  R  is  the  motor  resistance,  w  is  the 
rotational  speed  of  the  motor,  and  Kv  is  a  constant  of  proportionality  for  the  back-HMF  term. 
The  torque  n  produced  by  the  motor  is  directly  proportional  to  current: 

n  =  KnI  (17) 

In  voltage-control  mode,  for  example  in  a  chopping  circuit  where  duty  cycle  is  modulated, 
there  is  an  upper  voltage  limit  Vmax  which  can  be  applied  to  the  motor.  Because  of  the  bac*.- 
HMF,  the  maximum  current,  and  hence  the  maximum  torque,  is  velocity  dependent.  Assuming 
a  gear  ratio  of  1  (otherwise  absorb  the  gear  ratio  into  Kv),  then  w  =  6,  where  0  is  the  velocity 
of  the  joint  actuated  by  the  motor.  Combining  (16)  and  (17),  and  absorbing  the  gravity  torque 
j(0(t))  into  the  motor  limit, 

n+{t)  =  j? [Vmaz  -  Kv0(t))  -  g(0(t))  (18) 

If  the  trajectory  is  to  be  time-scaled  by  a  factor  c,  then 

n+(t)  =  *^Vmat  -  ^c0(ct)  -  g(0(ct))  (19) 

where  unlike  the  dynamic  terms  there  is  a  linear  dependence  on  the  scale  factor  c.  When  solving 
for  the  scaling  that  satisfies  the  upper  bound,  again  we  need  the  relations  ri0(t/c)  =  c2na(t) 
and  ri+(t/c)  =  n+(t).  'ITicrc  is  a  quadratic  equation  in  c  when  n+(t/c)  is  replaced  by  c2na(t) 
in  (19): 

n*(t)c2  +  ^~c9(t)  -  ^KmoI  +  p(0(t))  =  0  (20) 

When  solved. 


The  root  which  gives  the  largest  positive  c  should  be  chosen  for  c2+.  As  before,  it  is  possible 
that  there  is  no  positive  (or  even  real)  root,  which  indicates  that  the  trajectory  is  unrealizable. 
We  may  also  solve  (21)  with  Vmin  to  find  c2_.  Ihc  procedure  for  determining  the  appropriate 
trajectory  scaling  factor  then  follows  that  indicated  by  (9). 

The  back-KMF  can  be  considered  a  form  of  viscous  friction,  but  if  there  were  any  additional 
viscous  friction  at  a  joint  or  actuator,  it  could  be  handled  in  the  same  manner.  As  regards 
Coulomb,  or  sliding,  friction,  it  could  be  subtracted  from  the  motor  torque  limits  depending 
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on  the  direction  of  movement,  Lc.,  sliding  friction  torque  =  — n/sgn(#(f)).  Any  actuator 
springiness,  which  is  position-dependent,  could  also  be  readily  absorbed  into  the  torque  limits. 
Motor  inductance  unfortunately  seems  to  present  an  intractiblc  problem,  due  to  the  need  to 
find  the  time  derivative  of  the  dynamic  equation  (3). 

Conclusion 

Trajectory  planning  and  inverse  dynamics  may  be  efficiently  coupled  to  reflect  the  exact  influence 
of  actuator  torque  limits  on  execution  capability.  By  factoring  out  gravity,  a  time-scaling  property 
of  manipulator  dynamics  readily  allows  a  realizable  speed  of  movement  for  the  whole  trajectory 
to  be  determined  if  there  exists  one.  Rather  than  recomputing  the  dynamics  corresponding  to 
a  new  trajectory  speed  from  scratch,  the  dynamics  of  the  new  trajectory  is  obtained  by  a  simple 
linear  combination  of  components  of  the  original  trajectory  dynamics. 

Velocity-dependent  actuator  limits,  as  well  as  various  sources  of  joint  friction,  can  be 
accommodated  in  this  scheme.  An  important  side  effect  of  the  dynamic  time  scaling  property  is 
that  a  ubiquitous  assumption  in  manipulator  control,  namely  that  the  velocity-product  dynamic 
terms  are  significant  only  at  high  speeds  of  movement,  is  false:  these  terms  have  the  same 
significance  relative  to  the  acceleration  dynamic  terms  for  all  speeds  of  movement 
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